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Abstract 

Terrestrial manipulators with more dof than the dimension of the workspace 
and space manipiilators with as many manipulator dof as the dimension of 
the workspace are both redundant systems. An interesting problem of such 
redundant systems has been the repeatability problem due to the presence of 
nonholonomic constraints. We show in this paper, contrary to the existing 
belief, that integrability of the nonholonomic constraints is not a necessary 
condition for the repeatability of the configuration variables. There exist 
certain trajectories in the independent configuration variable space that are 
like “holonomic loops” along which the redundant manipulators exhibit 
repeatable motion. In this paper we present a simple method based on 
optimization techniques for designing repeatable trajectories for free-flying 
space manipulators and terrestrial redundant manipulators under 
pseudoinverse control. 
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1. Introduction 

An important problem of kinematically redundant robot manipulators lias been the 
repeatability problem under pseudoinverse control. This problem was initially observed and 
analyzed by Klein and Huang (7] where resolved motion rate control [22] using the Jacobian 
pseudoinverse was noticed to result in nonrepeatable joint motion. As an alternative to the 
pseudoinverse control, Baillieul [2] proposed the extended Jacobian techniQue that lifted 
closed end-effector paths to closed joint paths. Later, Seraji [15] proposed the configuration 
control technique that also resulted in repeatable joint motion. The key idea behind the 
extended Jacobian techniriue was to add enough independent additional constraints to the 
motion of the manipulator so that the rectangular Jacobian of the redundant mani]nilator 
could be converted into a square Jacobian of full rank. When the additional constraints 
that are imposed upon the motion of the redundant manijiulator are holouomic in nature, 
the full rank square Jacobian guarantees repeatability in the joint motion. 

Though the pseudoinverse control does not produce repeatable joint motion in general, 
it is fundamentally similar to the extended Jacobian technique in the sense that it is also a 
form of constrained motion. For a redundant manijmlator with n degrees of freedom and 
a workspace of dimension m, the dimension of the null space of the manipulator Jacobian 
is equal to (n - m). 'I'he extended Jacobian technique |2j imj)oses (n - m) additional 
independent constraints on the motion of the Si’stem to make the Jacobian s(iuare and lull 
rank. The pseudoinverse control is ecpiivalent to the imposition of {n-m) constraints that 
direct the motion of the joints orthogonal to the (n-m) dimensional mill s]>ace. While the 
constraints due to i)seud()inverse control are nonholonomic or nonintegrable, the constraints 
imposed by the extended Jacobian technique are holouomic or integrable. 'riiereiii lies the 
essential difl’erence between the two approaches, more of which will be discussed in section 
2 . 

d'he i^seiidoinverse control problem has been studied by a number of researchers |7|, 
[8], [9], and (Ki). Klein and Huang [7j analyzed the nonrepeatability problem of a three 
link planar redundant niani])ulator in terms of the integrability condition of a Pfa Ilian 
differential form. Shamir and Yomdin [IG] asserted that for a redundant manipulator 
repeatability is guaranteed if and only if there exists an integral surface of the distribution 
spanned by the column vectors of the Jacobian pseudoinverse. Under the dilfercntial 
geometric framework adopted, it was concluded that the repeatability of a redundant 
manipulator can be assured if and only if a certain “Lie Bracket Condition” (LBC) is 
satisfied. In section 3 of this paper we will show that this LBC is not a necessary condition 
for the repeatability of redundant manipulators. We will also show iu section 2 that 
the LBC is not a sufficient condition for repeatability when applied to arbitrary extended 
Jacobians. This contradicts some of the discussion by Luo and Ahmad |0] who disemssed the 
measure of repeatability for idanar redundant manipulators under pscud(jinverse control. 
They used a framework based on the theory of integration on manifolds. The authors in 
[7], [9], and [IG] have all concluded in essence that integrability is a necessary condition 
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for the repeatability in redundaut manipulators. Similar opinion was also expressed in [3], 
We do not quite agree with this statement. Our contention is that integrability is only a 
sufficient condition for repeatability, it is by no means a necessary condition. In section 3 
will derive a weaker necessary condition for the repeatability in redundant manipulators. 

In 1989 Klein and Kee [8] presented a numerical procedure to find stable drift-free 
trajectories in redundant manipulators under pseudoinverse control. Later, Klein [6] tried 
to predict the stable drift-free trajectories of [8] by using the Lie Bracket Condition (LBC) 
in [16]. The results indicated that the stable trajectories in [8] are not contained in the LBC 
surfaces of [16|. This bears testimony to the fact that the LBC of [16] is not a necessary 
condition for repeatability. 

Recently Roberts and Maciejewski [14] presental a necessary and sufficient condition 
for the existence of stable surfaces for repeatable motion in redundant manipulators. They 
showed that the Lie Bracket Condition (LBC) of [16] is a necessary condition for the 
existence of an integral surface, but it is not a sufficient condition for the surface to be 
stable for repeatability. Since stable surfaces are quite rare, the antliors [14] designed a 
repeatable control that is nearest, in aji integral norm sense, to a desired Ojjtimal control. 
In this paper we are concerned with rejjeatable trajectories but not with their stability. 
Though the LBC is a nec:essary condition for a stable surface, we show that it is not a 
necessary condition for repeatability. Using a necessary condition, weaker than the LBC, 
we will show the existence of “liolonomic loops” that lift closed paths in the worksi)ace to 
closed paths in the joint space under pseudoinverse control. 

With no intention of digressing, we would like to mention that space robots with as 
many manipulator degrees of freedom as the dimension of the workspace exhibit a special 
kind of redundancy called “nonholonomic redundancy”. It was shown that nonholonornic 
redundancy, unlike ordinary redundancy, manifests itself only after a global motion and 
is not characterized by “self-motion” manifolds [12]. Inspite of fundamental differences 
between nonholonomic ledundancy and ordinary kinematic redundancy, more of which 
will he discussed in section 2, the control problem in both is characterized by the non- 
integrability of the distrilnition spanned by the vector fields of the system. Hence the 
repeatability problem in space manipulators with no additional degrees of freedom and 
terrestrial redundant manipulators are inherently similar. 

Since space manipulators are also redundant systems, the repeatability problem in 
space manipulators fall within the scope of this research. While the problem of reorienting a 
space multibody system using internal motion has been studied by a number of researcheis 
[10], [11], [13], [18], [21], [23], etc., an important problem that has not been addressed so 
far is the repeatability problem in space manipulators. The motion of the end-effector of a 
space manipulator is related to the joint motions through the “generalized Jacobian” [19] 
by eliininating the de])endence of the end-effector motion on the change of orientation of the 
space vehicle. While the joints of the space robot move along closed imths, the orientation 
of the space vehicle does not. Conseciuently the end-elfector of the space inanipnlalor dues 
not move along a closed path. And conversely, the joints of the space robot fail to move 
along a closed path when the end-effector traces a closed path. While a more complete 



2 



discussion on this topic will follow in section 2.3, we only like to reiterate here that the 
manifestation of redundancy in terms of nonrepeatability in the configuration variables is 
observed in nonholonomically redundant space robots and ordinarily redundant terrestrial 
robots alike. 

The rest of the paper is organized as follows. In section 2 we take a look at the control 
of redundant manipulators, including space manipulators, from a different perspective. In 
section 3 we derive a necessary condition for repeatability in nonholonomic systems like 
space manipulators and redundant manipulators under pseudoinverse control. We use this 
necessary condition to find repeatable trajectories for nonholonomically redundant space 
manipulators in section 4 and ordinarily redundant terrestrial manipulators in section 5. 
In section 6 we present some results obtained through computer simulation. 

2. A Different Perspective on Redundant Manipulator Control 
2.1 Pseudoinverse Control as a form of Constrained Motion 

Kinematically redundant manipulators have more degrees of freedom than the dimen- 
sion of the workspace. For such systems, the direct kinematic relationshi]) can he written 
in the form 



x = f{0) (1) 

where x e R"‘ represents the workspace variables, 0 e R" represents the manipulator’s 
joint variables, and a > m by the definition of redundancy. Differentiating E(i.(l), we get 

x = JO, € R"‘^’‘ (2) 

where J is the manipulator Jacobian matrix. The pseudoinverse solution invokes the 
control law 



b = J*x (3) 

where J* e is the pseudoinverse of J. We will always assume in our discussion 

that the manipulator is not at any singular configuration. Therefore the Jacobian will 
always have full rank and the null s])ac:o of the Jacobian will have a dimension of (vi - m). 
The pseudoinverse solution has the minimum norm proirerty whicii iin])lies that the joint 
motion 0 obtained from Ecj.(3) will have to be orthogonal to the null space of J. 3'lie 
orthogonality requirement is a constraint on the joint velocities 0. Since the null space 
of J has a dimension of (/i - m), the pseudoinverse solution in E(i.(3) will impose {n - m) 
velocity constraints, 'lb illustrate this concept we consider the simple three link ])lanar 
redundant manipulator shown in Fig.l. The lengths of all the links of the manipulator are 
assumed to be unity for simplicity. 'I’he worksi>ace is defined by the Cartesian iroordinates 
X and Y and the manipulator configuration is described by the absolute angles Ou O 2 , and 
0-s. The direct kinematic relationship, as in Eq.(l), is of the form 
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A' = cos 0 \ + cos O2 + cos Oi 



(4) 



Y = sin + sin 62 + sin 0 -^ 
Therefore the Jacobian matrix, as in Eq.(2), is given by 



T _/-sintfi — sin -sintf3'\ 

® y cos 0i cos O2 cos $3 J ' ^ 

The Jacobian has a 1-dimensional null space whose basis vector can be conviniently ob- 
tained as a cross product of the row vectors of J^. The velocity constraint due to the 
pseudoinverse control can then be expressed as 



sin (03 — 02) <101 + sin ( 0 i — 03) (IO2 -(- sin (02 — 0 i) <103 = 0 (G) 

A necessary and sufficient condition for the integrability of a differential expression of 
the form 



vi da -|- V2 d /3 H- 113 dj = 0 



(7) 



is that [5] 






f 

\0l 





da ) 



= 0 



(«) 



Using the necessary and sufficient condition above, it is quite straightforward to show 
that the constraint due to pseudoinverse control, given by Eq.(G), is not integrable or 
nonholonomic in the general case. Therefore the three link manipulator shown in Eig.l 
has three expressions of motion under pseudoinverse control: the two kinematic relations 
given by Eq.(4), and one iionintegrable constraint given by Eq.(G). 

In the general case of a redundant niani])ulator with n joints in an ni-dimensional 
workspace, there are (/<- m) nonholonomic constraints (the numlier of nonholonomic con- 
straints is equal to tlie degree of redundancy in the system) imposed by pseudoinverse 
control and m kinematic relations for a total of n expressions of motion. Of course, the 
nonholonomic nature of the pseudoinverse constraints need to be ascertained from the 
more general test for integrability in n dimensions, provided in Appendix-A. 

When the manipulator has as many degrees of freedom as the dimension of the 
worksiiace, i.e. m = n, the Jacobian is stjuare and has no null sjiace assuming of course 
that the system is not at any singular configuration. Then the pseudoinverse control does 
not impose any nonholonomic constraints; the motion of the system is entirely governed 
by the n direct kinematic relations that are holonomic. 



2.2 Repeatability using the Extended Jacobian 

Consider a simple nonholonomic system whose constraint equation is of the form 



dz = a dx + b dy 



(9) 
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where x, y, and z are the system variables, and o and b are functions of x and y. Tlie 
variables x and y can be considered to be the independent variables of the system and ^ 
may be considered to be the dependent variable. If x and y move along a closed path, the 
change in the dependent variable z is expressed as 



I + 6 = g (I - I) 



In the above equation the line integral was conviniently expressed as a surface integral 
using the generalized Stokes’ Theorem [1] on the 2-diinensional oriented manifold D. dD 
is the path of line integration and is the boundary of the domain D. Since the constraint 
in Eq.(9) is a nonholonomic constraint, we can show 



db da 
Ox dy 

by using the test for integrability in Eqs.(7) and (8). Then it simply follows that the 
dejrendent variable z does not move along a closed jrath as the indei^endent variables x 
and y move along closed paths. Clearly, all the varialrles of the nonholonomic system 
in Eq.(9) do not move along closed paths simultaneously. This is true for nonholonomic 
systems in general including redundant manipulators under pseudoinverse control. The 
pseudoinverse control of ledimdant manipulators result in nonrepeatable motion of the 
joint variables. Conveisel}', holonomic systems are characterized by repeatability in the 
configuration variables that can be proven directly from the test for integrability. 

The problem of nonrepeatability of nonholonomically constrairred redrrndant nrarnprr- 
lators under irseudoinverse control can be remedied by rrsing the exterrded Jacobian nrethod 
[2]. For a n joint redrrrrdant rnaniirrrlator with an m-dirnensional workspace, the exterrded 
Jacobian method imposes (n - m) independent holonomic constraints of the form 



g{0) = ^K (]<)) 

These holonomic constraints are similar to the direct kinematic relations in Eq.(l) atrd 
can be used to arrgrnent the maniprrlator Jacobian in Eq.(2) for coirstnictirrg the exterrded 
Jacobian as follows 

(j^.) Jc = (II) e (II) 

The above eqiration indicates that we have artificially increased the dimensiorr of the 
workspace from m to n and in effect we rrow have a norrredrrndant marriprrlator with a 
square Jacobian. Rorrr otrr discirssion irr sectiorr 2.1, we krrow that the pserrdoitrveise 
control of such a marri]nrlator does not impose any nonholonomic constraints. The nro- 
tion of the system is therr governed completely by the m direct kirrernatic relatiorrs in 
Eq.(l) and the ( n — m) additional constrairrts of Erj.(lO). Ilolorromic systenrs are char- 
acterized by reireatability arrd the extended Jacobiarr techniciire achieves repeatability by 
converting the “redrrndant-maniprrlator-pseudoinverse-corrtrol” nonholonomic systenr irrto 
a holonomic system. 
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An alternative way to look at the extended Jacobian technique is to reconsider tlie 
constraints in Eq.(ll). If we group the joint variables 0 € ft" into two sets consisting of 
6\ € ft"* and O 2 € ft"""*, we can write from Eq.(ll) 

0=Joie, + Ja,b-,. (13) 

Since the {n-m) constraints in Eq.(lO) are all independent, it will be possible to find the 
set O 2 € ft"-’" such that the matrix Jc 2 is always invertible. Then E(is.(13) and (12) can 
be written as 



0-2 Jg2 * Ja\ 0\ (14) 

X =JOu J =(j,~ J 2 Jg 2 ~^Jgi) e (15) 

The above equations are modified differential forms of Eqs.(l) and (10) and are therefore 
holonomic in nature. Since the Jacobian J is square, the system in Eq.(15) virtually 
represents a nonredundant manipulator with x as the workspace and 0i as the joint space. 
Therefore the pseudoinverse control of E(i.(15) 

Oi = X (IG) 

imposes no nonholonoinic constraints. This follows from our discussion in section 2.1. This 
along with the fact that Eq.(15) is a holonomic equation implies that the constraints of 
motion of the system in Eci.(lfi) are holonomic. Therefore closed paths in the workspace 
X will result in closed paths in the joint space Oi, provided the manipulator does not pass 
through any singular conliguration. This follows from our discussion earlier in this section. 
Additionally, since E<p(14) is holonomic, closed paths in the space of the independent 
variables 0i will result in closed paths in the space of O 2 - the deirendent variable. In effect 
the extended Jacobian method will lift closed paths in the wor kspace x to closed pat hs in 
tire joint spac:e cominising of both 0i and O 2 . 

2.3 Redundancy in Space Manipulator Systems 

Space robots exhibit nonholonoinic redundancy [12] - a special type of redundancy 
that exists in the absence of ordinary kinematic redundancy. Unlike ordinary kinematic 
redundancy, nonholorromic redundaircy manifests itself only after a global motion and 
cannot be characterized hy self-motion manifolds. Inspite of fundamental dilferences, both 
redundancies are responsible for non reirea table motion of the configur ation variables under 
pseudoinverse control, 'riie nonrepeatability in the configuration variables are a direct 
manifestation of noiiholonomic constraints of motion. In the case of ordinarily r edundant 
terrestrial robots the noiiholonomic coiistraiiits are im])osed by the pseudoinverse control 
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itself, whereas in tlie case of space robots the nonholonoinic constraints are naturally 
imposed by the conservation of angular momentum. 

Consider a space manipulator system with manipulator joint variables 0\ € in a 
workspace x e The manipulator is chosen to have as many degrees of freedom as the 
dimension of the workspace to exhibit the manifestation of nonholonomic redundancy in 
the absence of ordinary kinematic redundancy. The orientation of the space vehicle on 
which the space manipulator is mounted is denoted by 6q e R'‘. Figure 2 depicts a planar 
space manipulator for which m = 2 and k = 1. It can be shown [11], [12] that the direct 
kinematic relation of the space manipulator is of the form 



X = f{Oi,Oo) ( 17 ) 

which has the structure 



X = J\ 0i Jo Oo ( 1 ^) 

in differential form. The nonholonomic constraint due to angular momentum conservation 
can be expressed as [11] 



do=^H{Oi)di ( 19 ) 

A complete description of the matrix H € can be found in [11], Equation (19) can 
be substituted in Eq.(18) to obtain 

x-JOi, J = {Ji + JoH) (20) 

where J e is the “generalized Jacobian” [19]. 

The generalized loordinatcs of the system include 0i e ft'“ and 9o 6 A*". The total 
number of generalized coordinates is {m + k) and the dimension of the workspace is m. 
The redundancy in the si)ace mani])ulator system is due to the higher dimension of tlie 
generalized coordinates than that of the workspace. The difference in the number of 
generalized cooidinates and the workspace variables is equal to the degree of ledundancy 
in the system. This is similai' to ordinary kinematic redundancy in terrestrial manipulators. 

A fundamental difference in the redundancy between space manipulators and terres- 
trial manipulators is that the dimension of the input space is equal to that of the gener- 
alized coordinates in the case of terrestrial manipulators whereas for space manipulators, 
the dimension of the input space is smaller than the dimension of the generalized coor- 
dinates. The inputs for terrestrial manipulators are the derivatives of all the generalized 
coordinates, for space manipulators they comprise of the derivatives of the independent 
generalized coordinates only, the orientation variables of the space vehicle being the de- 
pendent generalized coordinates. 

A closer look at Eqs.(19) and (20) point out their similarity to E(]S.(14) and (15). 
Though the equations look similar', they are fundamentally different because E(is.(14) and 
(15) are holonomic while E(is.(19) and (20) are nonholonomic in natnre. Due to this 
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difference, the extended Jacobian method of redundancy control results in repeatable joint 
motion in ordinarily redundant terrestrial manipulators whereas the pseudoinverse control 
of the generalized Jacobian (19) results in nonrepeatable joint motion in space manipulators. 
A more complete discussion on this topic is presented next. 

Consider the trajectory control in the three different cases of: (a) a nonholonomically 
redundant space manipulator, (b) an ordinarily redundant terrestrial manipulator, and (c) 
an ordinarily redundant terrestrial manipulator using the extended Jacobian. For case (a) 
the forward kinematics is expressed by Ecis.(17) and (19). Since Eq.(19) is nonholonornic, 
a closed path in 0i space does not imply a closed path in the 0o space. This implies from 
Eq.(17) that a closed path in the joint space of the space manipulator does not result in 
a closed path in the workspace. For cases (b) and (c) the forward kinematics is simply 
expressed by Eq.(l) - a position constraint. Therefore a closed path in the joint space 
will necessarily result in closed trajectories of the end-effector variables. For end-effector 
trajectory control in case (a), we use the pseudoinverse control law from Eq.(20) 

bi = J*X (21) 

to plan the joint trajectories. Equation (20) is a nonholonornic equation because it was 
obtained by substituting a nonholoiiomic equation, namely Eq.(19) into a holonoiuic equa- 
tion, namely Eq.(l8). Therefore, while using Eq.(2l), closed trajectories in the workspace 
will generally not result iu closed trajectories in the joint space. This can Ire easily proven 
by contradiction. Su))pose that closed trajectories in x produce closed trajectories in Oi. 
We know from the nature of Eq.(19) that closed trajectories in 0i do not usually ])ioduce 
closed trajectories in Oo- This will contradict Eq.(17) that requires the trajectories of 0o 
to be closed for closed trajectories of x and Oy. For case (b) closed trajectories in the 
workspace do not result in closed trajectories in the joint space whereas for case (c) they 



do. This follows straight from our discussion in section 2.2. 
summarizing the h'lst result in a tabular form. 


We conclude this section l)y 


Closed Path in Joint Space 
implies 

Closed Path in Workpspace 


Closed Path in Worksjjace 
implies 

Closed Path in Joint Space 


Space Manipulator False 


False 


Redundant Manii)ulator Tf ue 

(Pseudoinverse Control) 


False 


Redundant Majiipiilator Tf ue 

(Extended Jacobian) 


Tiue 



2.4 The LBC is not a Sufficient Condition for Repeatability 

Shamir and Yomdin [16] studied the repeatability ]>roblern in redundant manipulators 
and derived a necessary and sufficient condition, the Lie Bracket Condition (LBC), for 
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repeatability. In this section we will show that the LBC of [16] is not a sufficient condition 
for repeatability when applied to arbitrary extended Jacobians [2]. This contradicts some 
of the discussion made in [9]. 

In simple words, the LBC [16] states that repeatability in manipulators is assured if 
and only if the Lie Bracket of any two column vectors and kj of the matrix K , K being 
the pseudoinverse of the manipulator Jacobian, is a linear combination of the columns of 
K. 

For a manipulator with as many degrees of freedom as the dimension of the workspace, 
the control matrix K is simply the inverse of the manipulator Jacobian, assuming of course, 
that the manipulator is not at any singular configuration. The LBC is satisfied for the 
square and full rank matrix K, and indeed, we have repeatable joint motion when the 
end-effector moves along closed paths. 

Since the LBC is always satisfied for square matrices with full rank, Luo and Ahmad 
[9] extrapolated that repeatability can be achieved by simply converting the rectangular 
Jacobian of a redundant inanipnlator into a square matrix by inii)osing additional inde- 
pendent constraints. 'I'hey supported their arguinent with the exainjjle of the extended 
Jacobian (2j. This method achieves repeatability by imposing additional inde])endent con- 
straints that are holonomic. The assertion of Luo and Ahmad [9] is not correct because 
the rectangular Jacobian may be extended into a square matrix of lull rank by imposing 
nonholonomic constraints as well, and nonholonomic systems do not exhibit reireatability. 
To understand better, we look back at the expressions of motion of a redundant manip- 
ulator under extended Jacobian (xmtrol (2) and a space manipulator, in sections 2.2 and 
2.3 respectively. Specifically, we corni)are Eqs.(12) and (14) in section 2.2 with F(is.(18) 
and (19) in section 2.3. We have seen in section 2.3 that these two systems have struc- 
turally identical kinematical equations and constraints but the nature of their constraints 
are different. Since the space manipulator has nonholonomic constraints, closed paths in 
the workspace do not result in closed paths in the joint space. This tells ns that if the con- 
straint in Eq.(14) were nonholonomic, the psendoinverse control of the extended Jacobian 
of the redundant manipulator in section 2.2 would exhibit nonrepeatable joint motion as 
well. 

To illustrate nonrepeatability in redundant manipulators with an extended Jacobian, 
we consider the manipulator in Fig.l. We assume all the link lengths to be equal to 0.5 units 
for the sake of simplicity. For this manipulator which has a single degree of redundancy, 
we impose one nonholonomic constraint 



O3 = sin(^i -h O3) bi -f- cos (^^2 + O's) b'2 

The extended Jacobian relation of the manipulator takes the following form 

f X\ j / — sin -sin <>2 -sin^^aX fbi\ 

I T J = - I cos 0i cos O2 cos O2 1 I ^2 ) (22) 

\ 0 y ysin(0i -I- <^3) cos(02 + ^3) / \^ 3 / 

Except at the singular points, the pseudoinverse of the extended Jacobian in Eq.(22) 
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will be equivalent to the inverse, for which the LBC will always be satisfied. However, 
closed paths in the worksjiace x will not always result in closed paths in the joint space 0, 
as seen from Fig.3. Therefore, the assertion made in [9] is not correct. 

We wish to make two comments in regard to Fig.3. The abcissae and ordinate in Fig.3 
are in different scales. Therefore the circular path of the end-effector looks elliptical. For 
the same reason, the link lengths seem to vary in different configurations. Also, it may be 
noted that the manipulator exhibits a limit cycle behavior - the drift in the joint angles 
of the manipulator decreases as the end-effector repeatedly moves along the closed path. 
This limit cycle behavior of redundant manipulators will be explained later in section 5. 

3. A Necessary Condition for Repeatability 

Shamir and Yomdin [16] studied the repeatability problem in redundant manipulators 
and arrived at a Lie Bracket Condition (LBC) as a necessary and sufficient condition for re- 
peatability. The f.,BC is by itself a necessary and sufficient condition for the integrability of 
the distribution associated with the Jacobian pseudoinverse. This comes directly from the 
statement of Ifiobenius’s Theorem [17]. This was proven separately for the 3-dimensional 
case in [9], [14]. In essence, Shamir and Yomdin [16] asserted that repeatability can be 
achieved if and only if the solution to the pseudoinverse control problem is integrable. We 
do not quite agree with this condition since there exists a weaker necessary condition for 
repeatability. 

Terrestrial redundant manipulators under pseudoinverse control and nonholononiically 
redundant space manipulators are both constrained systems, and the rei.)eatability jiiobleni 
in these redundant systems is a search for closed trajectories of their configuration variables. 
We take into consideration the constraints of the systems by searching for closed trajectories 
of the independent configuration variables that result in closed trajectories of the dependent 
configuration variables. The change in the dependent configuration variables is expressed 
as a line integral along the closed jiatli in the sjiace of the indeiiendent configuration 
variables. This line integral may be conviniently expressed iis a surface integral using the 
generalized Stokes’ Theorem on a manifold. If D is an oriented manifold of dimension k, 
and if w is a (k - l)-fonn on D, then from Stokes’ Theorem [1] we have 

f u»= / da; (23) 

JdO Jd 

where, dD is the path of the line integration and is the boundary of the domain D, and 
da> is a differential ^-form obtained by exterior differentation of u. In the case of a planar 
terrestrial manipulator with three links and a single degree of redundancy, the domain D is 
a 2-dimensional manifold, and the differential 1-form on D has the functional dependence 

u> = d4>0 = (‘•^ 4 ) 

where, <^u is the dependent joint variable, and <l>i and 4>2 ai'ti the independent joint vari- 
ables of the manipulator. If Eq.(24) were to depict the constraint in a nonholononiically 
redundant planar space robot with two links, 4>o would rejnesent the orientation of the 
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space vehicle in the plane, and 4>i and <t >2 would represent the joint variables of the two 
link manipulator. 

Using Stokes’ theorem, the line integration of d<j>o along a path DD on the 2-dimensional 
manifold D of 4>i and 02 is expressed as 





Ogi 

d<t>2 

04>2 



dtp I A d<f>2 
d4>id<l>2 



where “a" denotes the exterior product, and a, the orientation of D has the same orien- 
tation as c/01 A c/02 when the direction along the path is counterclockwise, otherwise a has 
the same orientation as c/02 a c/0i. 

If the constraint given b)' Eq.(24) were a holonomic constraint, then we w'ould have 



( 25 ) 



(>02 ^ 

501 502 

Then the change in the variable 0o would be zero for all closed paths in the domain 
D because of the integrable nature of the constraints. This would ensure rei)eatability. 
Our contention is that integrability is a sufficient condition for repeatability but is not 
a necessary condition. For the nonholonomically redundant space manipulator or the 
terrestrial redundant manipulator the condition given by E<i.(25) does not hold good, yet 
repeatability can be achieved for certain closed paths in the domain D. We define 



d<j2 5 < 7 i a . 



(2C) 



The change in the dependent joint variable 0o of the redundant manipulator for a positive 
direction of travel in the space of the independent joint variables is equivalent to 



/ c/00 = f /^(0|,02) </0ld02 
Jdo Jd 

= F'{<P\,r2)f c/0ic/02 = F(0I,05)>1(D) 

Jd 

where, the above eciuation was obtained by the application of the mean value theorem 
of integral calculus. The function F is assumed to be continuous in the entire domain 
D and hence the mean value theorem applies. 4>\ and 02 denote some point within the 
domain D, and A(D) is the measure of the domain D\ in this case it is simply equal to the 
area enclosed within the closed curve 5D. can also be interpreted as the mean 

value of the function F, defined in Eq.(2G), taken over the domain D. If this mean value 
happens to be zero, then we would have a zero net change in the dependent joint variable 
of the redundant manipulator. This would ensure repeatability in the joint motion of the 
terrestrial manipulator. For the space manipulator this would ensure rejreatability in the 
motion of the end-effector in the workspace. We are now ready to state the necessary 
condition for the repeatable motion of the redundant manipulator. 
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Proposition: A necessary condition for llie repeatable motion of the redundant manipu- 

lator is that the closed path OD which is the boundary of the domain D in the independent 
configuration space should enclose at least one point where the function F defined by 
Eq.(26) is equal to zero. 

The proof of the proposition stated above is (juite straightforward and is left to tlie reader. 

If the necessary condition for repeatability is satisfied, it may be possible to find 
paths in the space of the independent configuration variables such that the net change 
of the dependent configuration variables is zero over the closed path. The closed path in 
the independent configuration space will then be like a “holonomic loop” over which the 
nonholonomic system will exhibit holonomic behavior globally. Incidentally, the holonomic 
loops will not belong to any integral surface and as such the LBC or the integrability 
condition, defined in Appendix-A, will not be satisfied at all points along the loop. 

4. Repeatability in Nonholonomically Redundant Space Manipulators 

There are two different repeatability problems for a space manipulator system: (a) the 
direct problem of finding a closed path in the joint space of the manipulator such that 
the end-effector traces a closed path, and (b) the inverse problem of finding a closed path 
in the worksirace that will result in a closed path in the joint space under pseiidoinverse 
control. The inverse problem can be solved by simply solving the direct problem when 
the number of manipulator joints is ecpial to the dimension of the workspace, as in our 
case. This is true because in such situations the pseiidoinverse is identical to the inverse 
assuming that the manipulator is not at any singular configuration. In this section we 
consider the direct repeatability problem of a planar space robot with two links mounted 
on a space vehicle as shown in Fig.2. Since the manipulator has two links, the system will 
exhibit nonholonomic redundancy in the absence of ordinary kinematic redundancy. 

The Cartesian cooi (final, es of the end-eflector x/j, yE of the manipulator have a func- 
tional dependence of the form 



VE = hi^o,yo,0o,0i,02) (27) 

where xo and yo are the coordinates of the center of mass of the space vehicle, Oq is the 
orientation of the vehicle, and 0i and 0-2 are the joint variables. The motion of the center of 
mass of the space vehicle is governed by a holonomic constraint due to linear momentuin 
conservation. For zero initial linear momentum, this can be reduced to the form [11] 



X0 = hiOo.0 1 , 0 - 2 ), y<i = f4{0o,0x,e-2) (28) 

Since we are looking into the repeatability problem of a planar space robot, we consider 
closed trajectories of the joint variables. If the orientation of the space vehicle trace a closed 
curve as the joints move along a closed trajectory, it is clear from Eqs.(27) and (28) that all 
the configuration variables including xo, yo, xe, and ys will move along closed trajectories. 
This is not true in the general case. 
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When the joints move along closed trajectories and the system maintains zero angular 
momentum, the change in the orientation of the space vehicle is expressed as a surface 
integral using the generalized Stokes’ Theorem on a manifold, as given by Eq.(23). The 
domain D will be the 2-dimensional joint space of the manipulator and the diffeiential 
1-form on D will be the constraint due to the conservation of angular momentum, given jis 



u> — (IOq = Pi(^i) ^2) + 52 (^i» ^2) <^^2 

where A, B, and C are functions of 61 and $2 and are defined in Appendix-B. The function 
F defined in Ec|.{26) is therefore equal to 






( 30 ) 



We now present a simple method to plan repeatable paths for the space manipulator. 
All paths that will ensure repeatability will have to satisy the necessary condition for 
repeatability, developed in section 3. Therefore, we first take a look at all points in the 
Oi -02 space where the function F{ 0 i, 02 ) in Eq.(30) is identically zero. The set of all such 
points constitute a smooth curve, as seen in Eig.4. 

We assume our closed path to have an elliptical shape. This path, as seen in Fig. 5, 
can be parameterized as follows: 



01 = Oio -f a cos 4> cos 2nt — b sui (p siii 2nt 

02 — 020 + « siu <f> cos 2T\t -t b cos (j> sin 2nt 



I € (0, 1] 



( 31 ) 



where, a, and b are the major and ininoi’ axes of the ellipse, <p is the angle of inclination 
of the ellipse with the 0i axis, and 0io and ^>20 are the coordinates of the center of the 
ellipse. The velocities of the joints of the manipulator can be easily obtained frt)ui the 
above equation as a function of time. Consequently, the rate of change of the orientation 
of the space vehicle can be obtained from Eq.(29) as a function of time. 

We start with an initial elliptical path which is characterized by the parameters 0io, 
020, a, b, and </>. I'he initial choices of these pai'ameters are quite arbitrary. We only make 
sure that the elliptical path encompasses at least one point where the function F defined 
by Eq.(30) is ccjual to zero. 'I'his condition can be easily satisfied by considering l''ig.'1 
which provides the set of all points where the function F vanishes. 

Our goal is now to change the five parameters of the ellipse so that the surface integral 
of the function F in E(j.(30) over the elliptical path is equal to zero. Of the five dilferent 
parameters a and b are not allowed to change independent of one another. This is because 
we want to eliminate the trivial solution where the surface integral is zero because the ai ea 
of the closed path is ecpial to zero. One simple way to avoid this situation is to iin])ose the 
restriction that the area of the ellipse is a constant. 'I'his is eciuivalent to the consLrai)iL 



0 ( 0 ) + b da — 0 



( 32 ) 
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We define a function V as follows 



^ IId 

and solve the unconstrained minimization problem by implicitly assuming that a and b 
are dependent. In Eci.(33) C is equal to the net change in the orientation of the space 
vehicle as the joint variables move along closed paths. While there are many methods for 
unconstrained minimization, we choose the simplest method of steepest descent [20]. Other 
alternative methods that can be used are the conjugate direction method by Fletcher and 
Reeves [4], and the variable metric method [20] that offer improvement over the method 
of steepest descent. In our case the method of steepest descent works well and therefore 
we adopted it only for its simplicity. 

The correct choice of the independent parameters ^lo, ^ 20 , </>, and a that provied us 
with the steepest direction of descent of the function V are computed as 



dOio — 



dC 

dOio' 



dOio = -C 



o<: 

dO-2o' 





In the above equation, the quantities (DC/dOio), {di^/dO-jo}, (^C/^<A)i and {d(i/da) are com- 
puted by numerical partial dilferentiation. While computing the term {dC,lbu) it has to be 
remembered that a change in a is accompanied by a change in b given by the constraint in 
Eq.(32). 

The optimizati(m teclmiciue discussed above provides us with a systematic way to 
reach the local minimum value of the function V. If this minimum value is zero, then we 
have converged upon the desired path around which the space robot will exhibit pseudo- 
holonomic behavior. In the general case, the method of steepest descent does not guarantee 
the convergence of a function to its global minimum value. However, in our case the method 
always converged to the global minimum value of F == 0, because of the particular nature 
of the function F in E(j.(30). 



5. Repeatable Motion under Pseudoinverse Control 

'I’he repeatability problem in redundant manipulators under pseudoinverse control is 
a search for closed trajectories of the end-effector that result in closed joint trajectories. 
Since the pseudoinverse control is actually a form of nonholonomically constrained motion, 
closed joint trajectories can be obtained only if the de])endent joint variables move along 
a closed path as the independent joint vmiahles do. Our logical first step is therefore 
to search for closed trajectories of the independent joint variables that result in closed 
trajectories of the dependent joint VcU iables. 

To further our discussion, we consider the planar redundant manipulator in Fig.l with 
unity link lengths. This example was considered in [7], [9], and [IGj. The kinematic 
relations of this manipulator are given in Eci.(4) and its Jacobian is given by Eq.(5). The 
noiiholonomic constraint of the manii)nlator under pseudoiiiverse control is given hy l'ki.(O), 
which is not of the form given by E(j.(24). To reduce it to this form, we use the simple 
transformation 
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V"! = 1 V'2 = ^2 - , V'a = — O 2 



( 34 ) 



The transformed constraint equation 



(sin(V'2 + V'3) ~ sin V'2 ~ sin V'al t^V*! ~ sin V*2 + lsin(V'2 + V'a) ~ sin V'2) ‘fV'2 = ( 35 ) 

is then of the form as given by Eq.(24). Under the assumption that 

sin V'2 + sin V'3 — sin(V'2 + V'3) 7^ 0 ( 3 C) 

the change in the dependent variable V'l, as the independent variables V'2 and V'3 move 
along a closed path, can be shown to be 

[ ff p — ; M 

JdD JJd |siii V '2 + Sin V'3 - sin(V '2 + V'3)] 
using Stokes’ Theorem [1]. The function F defined by Eki.(26) is given as 

^(V'2, V'3) = , ■ , ^ ■ , / . / M 

|sin V '2 + sin V'3 - sin (V '2 4- V'3)] 

and is not equal to zero anywhere in the V' 2 -V '3 plane. The necessary condition for repeata- 
bility is therefore not satisfied. This means that when the condition in Eq.(36) holds good, 
the redundant manipulator cannot exhibit repeatability. The condition in Eq.(36) does 
not hold good when we have any one of the three cases 

(a) V '2 — fi ^1 = ^2 

(b) V '3 = 0 O2 — Oi 

(c) V'2 4 - V '3 = 0 <==J> Oi = 0 i 

Using Eq.(35), it is ])ossible to show that the three cases above imply 

(ti) V '2 = 0 ►— » VV '2 = 

( 6 ) V '3 = 0 0 il>i — 0 

(c) V '2 4- V'3 = •-» (/(V'2 4- V'3) = 

Therefore, each of the three cases represent an integral surface. These results are identical 
to that obtained by Shamir and Yomdin [16] using the Lie Bracket Condition (LBC). We 
have to agree that for the particular example considered, repeatability can be achieved 
only if the LBC holds good, i.e. the LBC is a necessary condition for repeatability. 

The LBC is not a necessary condition for repeatability in the general case. To illustrate 
this concept we consider the same manipulator as in Eig.l, but we redefine the configuration 
variables. Once again we assume the link lengths to be unity for the sake of simplicity. 
If the new configuration variables are V'l. V' 2 , and V' 3 , as defined by Eq.(34), then the 
kinematic relations of the manipulator are 
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X = cos V<1 + cos V>12 + cos ^123 
y = sin 4 >i + sin ^12 + sin ^<123 



(38) 



and the manii)ulator Jacobian is given by 



J _ -sinV'i -sinv!'i2 -sin^i 23 -sin ^12 - sin ^>123 -sin^&i 23 \ 

where we used tlie compact notation ^12 and ^123 to denote (V>i + 1 P 2 } and + v !'2 + 
V< 3 ) respectively. We note that tlie Jacobian in the above equation is quite difteient 
from the Jacobian Jg in E(i.(5). Consequently, the pseudoinverse control for would be 
considerably different from that of Jg. 

The nonholonomic constraint of the manipulator under pseudoinverse control of is 
found to be 



sin V>3 - [sin + sin(^2 + V'3)| <^^2 + (sin ip2 + sin(v!'2 + ^^3)) = 0 (40) 

Assuming sink’s ^ 0 , the change in the dependent variable as the independent variables 
ip 2 and V >3 move along closed paths, can be shown to be 




sin ipi cos tp2 -t sin cos (^2 + V's) — sin ^2 
sin 



dlp2(l4>3 



d'he function [•' defined in E(i.(2G) is therefore equal to 



(41) 






sill 4^3 cos 4>2 + sin 4>3 cos(^2 + 03) — sin ip2 
sin 03^ 



(42) 



To plan repeatable paths for the redundant manipulator under iiseudoinverse control, 
the necessary condition for repeatability discussed in section 3 has to be satisfied. J’here- 
fore, we take a look at a set of points where the function F(02>03) vanishes. A .set of these 
points is given in Fig.fi. We assume the closed path in the space of the independent joint 
variables, 02 and 03 , to have an elliptical shape, as shown in Fig. 7. The path in 02 and 
03 is parameterized in a way similar to E)q.(31). We start with an initial choice of the 
parameters 02 o, 03o, «, b, and 0. The choice is quite arbitrary except for the fact that the 
path should enclose at least one point where the function F defined by Eq.(42) is e(|ual 
to zero. This condition can be satisfied by considering Fig.C. Our goal is now to change 
the five parameters of the elliptical path so that the surface integral of the function F in 
Eq.(42) over the path is equal to zero. We achieve our goal by adopting the optimization 
technique outlined in section 4. The optimized path can then be likened to a “holonomic 
loop” over which the joint angles of the redundant manipulator will exhibit holonomic 
behavior globally. 

Let us define the o])timized closed jiath in the joint space to be Cj. Using forward 
kinematics, as given by Eq.(38), we can obtain a closed path in the workspace Cw of the 
redundant manipulator from Cj. Under pseudoinverse control, Cw will map back to Cj 
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in the joint space. Tliis is true because (a) the mapping Cj < — * satisfies the kine- 

matic relations of the manipulator, and (b) the closed path Cj satisfies the nonholonomic 
constraint due to pseudoinverse control. 

Before we conclude this section we wish to make two comment: 

1. It can be shown that the Lie Bracket Condition (LBC) in [16] is not satisfied at every 
point on Cj, yet the net change in the dependent joint variable V*! along Cj is zero. 
Therefore, we can achieve repeatability in the absence of an integral surface. 

2. Our second comment is in regards to the limit cycle behavior in redundant manipu- 
lators. It was noted in [7] that under pseudoinverse control some manipulators drift 
continuously while others exhibit limit cycle behavior. Our studies lead us to believe 
that the drift in a redundant manipulator may be self-optimizing in the sense that 
the drift may decrease with every cycle of end-effector motion. When such a situation 
arises, the drift finally goes to zero and the manipulator reaches a limit cycle. 

6. Simulations 

6.1 A Nonholonomically Redundant Space Manipulator 

We carried out several computer simulations. Here we present results of one particular 
case. The kinematic and dynamic parameters of the planar' space robot were chosen to be 

Kinematic and Dynamic parameters 





Mass 


Inertia 


Length 








(m) 


Vehicle 


27.440 


1.520 


r = 0.20 


Link-1 


5.380 


0.115 


h = 0.50 


Link-2 


2.G40 


0.028 


62 = 0.35 



The initial pai'ameteis of tire elliptical path were arbitrarily chosen as 

a = 1.50000, 6 = 1.00000, ^ = 0.75000, <?io = 0.50000, <^20 = 0.50000 (43) 

where the units are in radians. For these set of values, the numer ical value of the surface 
integral C was found to be C = -0.1G2775. The convergence criterion was set at 1C I < 
1.0 X 10~®. The values of the path parameters after convergence were 

a = 1.31117, 6= 1.14381, <f> = 0.79302, = 0.34094, 620 = -0.07054 (44) 

The two elliptical paths are shown irr Fig.8. Ellipse I corresponds to the initial choice 
of the path parameters given by Ek}.(43) for which the value of C = -0.162775. Ellipse 
II corresponds to the optimized values of the path parameters given by Eq.(44) and the 
vahre of C for this path was C = -9.9G36 x 10“'-'. The siimsoidal curve in Fig.4 is inset in 
Fig.8. This curve passes through both paths I and II and therefore these paths satisfy the 
necessar'y condition discussed in section 3. 
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Figures 9 and 10 depict the motion of the end-effector of the space robot for 20 cycles 
for the elliptical paths I and II respectively. The end-effector configuration is seen to drift 
in Fig.9 but has negligible drift for the closed path in Fig.lO. The magnitude of the drift 
was computed to be approximately 76.9G mm/cycle in the case of path I whereas it was 
only 0.87 mm/cycle for path II. 

6.2 An Ordinarily Redundant Terrestrial Manipulator 

We considered the simple case of a planar' three link manipulator with one degree 
of redundancy, as shown in Fig.l. The kinematic relations of the manipulator and its 
Jacobian are given by Eqs.(38) and (39). We assumed the links of the manipulator to have 
equal lengths of 0.5 metres. 

The initial parameters of the elliptical path was arbitrarily chosen as 

a = 1.00000, t=1.00(K)0, </. = 0.00000, V '20 = 0.75000, = 1.50000 (45) 

where the units are in radians. For these set of values, the numerical value of the surface 
integral C was found to be C — 1.9838025. The convergence criterion was set at |C| < 
1.0 X 10“®. The values of the path parameters after convergence were 

a = 1.03337, 0 = 0.90709, <;<. = 0.00232, V <20 = 0-51512, V' 30 = 1-42478 (40) 

The two elliptical paths are shown in Fig.l 1. Ellipse / corresponds to the initial choice 
of the path i>arameters given by E(j.(45) for which the value of C = 1.9838025. Elli])Se // 
corresponds to the oirtirnized values of the iiath parameters given by Eq.(4G) and the value 
of C for this path was C = 9,9431 x 10~‘-*. The sinusoidal curve in Fig.6 is inset in Fig.l 1. This 
curve passes through both paths / and II and therefore these paths satisfy the necessary 
condition discussed in section 3. 

Path II in Fig. 11 is the optimized path in the 4>2->p3 plane of the manipulator that 
results in closed loop motion of the dependent joint variable ^ 1 . For an initial value of 

V»i = 0.0, the closed end-effector trajectory Cw that is obtained from these closed joint 

trajectories Cj is shown in Fig. 12. Figure 12 also shows the link configuration of the 
manipulator at six different points along the trajectory. The joint trajectories obtained 
through pseudoinverse control of the closed end-effector trajectory in Fig. 12 are shown in 
Fig. 13. The joint trajectories in Fig. 13 pertciin to 5 cycles of end-effector motion. The 
numerical simulation was continued for more than 100 cycles and the joints were seen to 
have exceptional repeatability. This conforms to our discussion in section 5. 

We wish to make two comments at this juncture; 

1. The Lie Bracket Condition (LBC) in [IG] is essentially a test for integrability of the 
distribution spanned by the column vectors of the Jacobian pseudoinverse. Though 
the LBC can be verified from the Jacobian transjrose instead of the i)seiidoinverse [9], 
[14], it may still involve a significant amount of symbolic computation. An easier way 
out is to test the integrability of the constraint imposed by the pseudoinverse control. 
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We can use Ekis.(7) and (8) to test the integrability of the pseudoinverse constraint 
In Eq.(40). For tlie joint trajectories in Fig. 13 it can be shown that the condition for 
integrability is not satisfied at all points along the path, i.e. F(V’ 2 .V' 3 ) in Eq.(42) is not 
zero at all points along the path. Therefore repeatability is achieved in the absence of 
integrability. This refutes the LBC in [16]. 

2. Since the end-effector trajectory is generated from the joint trajectories and since 
the initial configuration of the dependent joint variable, V”! in our case, is completely 
arbitrary, any rotation of the end-effector trajectory in Fig. 12 about the z-axis will also 
produce repeatable joint motion. Clearly, there are infinite end-effector trajectories 
that produce repeatable joint motion. 

7. Conclusion 

In this paper we promoted the concept that integrability is not a necessary condition 
for repeatability in noiiholonomic systems. This allows us to plan re])eatable trajectories 
for free-flying space manipulators with zero initial momentum whose constraint due to the 
conservation of angular momentum is not integrahle. This is imirortant because it allows 
a space manipulator to perform repeated tasks in space without any drift in its configura- 
tion variables. For terrestrial manipulators under pseudoinverse control the noiiholonomic 
constraint is imposed by the control law. We showed that under pseudoinverse control, 
repeatability of the joint variables can be achieved in the absence of any integral surface 
and by virtue of the presence of “holonomic loops”. These loops, when they exist, allow 
a nonholonomic system to exhibit repeatability in its configuration variables, in this pa- 
per we presented a simple optimization technique for planning repeatable trajectories for 
both nonholonomically redundant space manipulators and ordinarily redundant terrestrial 
manipulators. 



REFERENCES 

[1] Arnold, V. I., 1989, “Mathematical methods of classical mechanics”. Springer Verlag. 

[2] Baillieul, J., 1985, “Kinematic programming alternatives for redundant manipulators”, 
Proc. IEEE International Conference on Robotics and Automation, pp. 722-728. 

[3] Baker D. R., and Wampler II, C. W., 1988, “On the inverse kinematics of redundant 
manipulators”. International Journal of Robotics Research, Vol. 7, No. 2, pp. 3-2 J. 

[4] Fletcher, R., and Reeves, C. M., 19G4, “Function Minimization by Conjugate Gradi- 
ents”, “Computer Journal”, Vol. 7, No. 2, pp. 149-154. 

[5] Ince, E. L., 1956, “Ordinary Differential Equations”, Dover Publications, New York. 

[6] Klein, C. A., 1993, “The Lie Bracket Condition as a Test of Stable, Drift-hVee Pseu- 
doinverse Control”, IEEE 'Aansactions on Robotics and Automation, Vol. 9, No. 3, pp. 
334. 

[7] Klein, C. A., and Huang, C. H., 1983, “The Nature of Drift in Pseudoinverse Control 



19 



of Kinematically Redundant Manipulators”, IEEE ^Ransactions on Systems, Man, and 
Cybernetics, Vol. SMC13, pp. 245-250. 

[8] Klein, C. A. and Kee, K. B., 1989, “The nature of drift in pseudoinverse control of 
kinematically redundant manipulators”, IEEE Transactions on Robotics and Automation, 
Vol. 5, pp. 231-234. 

[9] Luo, S., and Ahmad, S., 1992, “Predicting the Drift Motion for Kinematically Redun- 
dant Robots”, IEEE Transactions on Systems, Man, and Cybernetics, Vol. 22., No. 4., 
pp. 717-728. 

[10] Mukherjee, R., and Anderson, D. R, 1993, “A Surface Integral Approach to the Motion 
Planning of Nonholonornic Systems”, Proc. 1993 American Control Conference, Vol. 2, 

pp. 1816-1822. 

[11] Nakamura, Y., and Mukherjee, R., 1991, “Nonholonornic Motion Planning of Space 
Robots via a Bi-Directional Approach”, IEEE Transactions on Robotics and Automation, 
Vol. 7, No. 4, pp. 500-514. 

[12] Nakamura, Y., and Mukherjee, R., 1993, “Exploiting Nonholonornic Redundancy in 
Piee-Flying Space Robots”, IEEE llansactions on Robotics and Automation, Vol. 9, No. 
4, pp. 499-506. 

[13] Reyhanoglu, M., and McClaniroch, N. II., 1992, “Planar Reorientation Maneuvers of 
Space Multibody Systems using Internal Controls”, AIAA Journal of Guidance, Control 
and Dynamics, Vol. 15, No. 6, pp. 1475-1480. 

[14] Roberts, R. G., and Maciejewski, A. A., 1992, “Nearest Optimal Repeatable Control 
Strategies for Kinematically Redundant Manipulators”, IEEE Transactions on Robotics 
and Automation, Vol. 8, No. 3, pp. 327-337. 

[15] Seraji., H., 1989, “Configuration Control of Redundant Manipulators: Theory and 
Implementation”, IEEE 'IVansactions on Robotics and Automation, Vol. 5, pp. 472-490. 

[16] Shamir, T., and Yoindin, Y., 1988, “Repeatability of Redundant Manipulators”, IEEE 
IVansactions on Automatic Control, Vol. 33, pp. 1004-1009. 

[17] Spong, M. W., and Vidyasagar, M., “Robot Dyanamics and Control”, John Wiley and 
Sons, New York. 

[18] Sreenath, N., 1992, “Nonlinear Control of Planar Multibody Systems in Shape Space”, 
Mathematics of Control, Signals, and Systems, Vol. 5, pp. 343-363. 

[19] Umetani, Y., and Yoshida, K., 1987, “Continuous Path Control of Space Manipulators 
Mounted on OMV”, Acta Astronautica, Vol. 15, No. 12, pp. 981-986. 

[20] Vanderplaats, G. N., “Numerical 0|)timization Technologies for Engineering Design”, 
McGraw Hill Book Company, San FVancisco. 

[21] Walsh, G., and Sastry, S., 1991, “On Reorienting Linked Rigid Bodies using Internal 
Motion”, Proc. IEEE Conference on Decision and CoTitrol, (Brighton, England), pp. 1190- 
1195. 



20 



[22] Whitney, D. E., 1969, “Resolved Motion Rate Control of manipulators and human 
prostheses”, IEEE Transactions on Man-Machine Systems, MMS-10, (2), pp. 47-53. 

[23] Yamada, K., and Yoshikawa, S., 1992, “Arm Trajectory Design of a Space Robot”, 
Proc. 18th International Symposium on Space Technology and Science, (Kagoshima, 
Japan). 



APPENDIX-A 

The necessary and sufficient condition that the differential constraint in n variables 

dxi + V2 dx-i -f • • ■ + dxn = 0 

is integrable, is that the set of equations 




1.2. -.n) 

are satisfied simultaneously for all different combinations of A, ^ and u [5]. 



APPENDIX-B 

The terms A, B, and C in Eq.(29) are defined as follows 



A 1 

A ~ It —r'^'fnoinii + m 2 ) + + nii77i2 + 47nor?i2) + *7T7m2(7no -f mi) 

M 4.M 4Ai 

4 ^?/io(?Hi \ 2in2)rlicos0i \ -^in2{mo -\- {).5ini)lil2Cos O 2 I i I ^ 2 ) 



A 

R = /i + ^2 + TT7(''‘0»»1 + rnim^ + moin^) + + mj) + + 2m2)rlicos0x 



_ 2 _ 

A/’ 



+ — mjfmo + 0.5»71 i)1i/2Cos<^2 + + ^ 2 ) 



M 



2M 



A 1 1 

C = -^rni{mo H- mi) + -—moin^hhcos 62 + -:^mom 2 rl 2 COii{ 0 ]^ + O 2 ) 

AM 2M 2M 

where, mo, mi, and m 2 are the masses of the space vehicle and the two links of the ma- 
nipulator, /o, /i, and h are the moment of inertias of the space vehicle and the two links 
about their center of masses, r is the distance of the first joint from the center of mass of 
the vehicle, li and h are the lengths of the two links, M = mo mi -\- m 2 , and A = Io \-h + h- 
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Figure 1. A planar three link redundant manipulator. 
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(^o> yo) = center of mass (C.M.) of space vehicle 

(x£, yg) = coordinates of the end-effector 
X 



Figure 2. A two link planar space manipulator mounted on a space vehicle. 
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Figure 3. Nonrepeatable joint motion of the three link redundant manipulator under 
pseudoinverse control of its extended Jacobian. 
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Figure 4. The locus of points in tlie O 1 -O 2 plane of the planar space robot where F{0i,0i) = 



02 




Figure 5. Parametric representation of the elliptical path in the joint s])ace of the space 
robot. P is the center of the ellipse, and </> is the angle between the major axis of the ellijjse 
and Oi. 







Figure 6. The locus of points in a certain region of the plane of the three link 

redundant manipulator where F(V'2.i/'3) = 0. 
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a = semi-major axis of ellipse 
b = semi-minor axis of ellipse 




Figure 7 . Parametric representation of the elliptical path in the space of the independent 
joint variables of the redundant manipulator. P is the center of the ellipse whose major 
axis subtends an angle 0 with 02- 
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Oj (rad) 



Figure 8. Elliptical paths in the joint space of the planar space robot. Path I is the initially 
chosen path and Path 11 is the optimized ]>ath. 
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Figaro 9. Eiul-oHeclor drift in 20 cycles for Path 1 in the joint space of the space robot. 
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X coordinate of end — effector (m) 



Figure 10. Repeatable end-effector motion for Path II in the joint space of tlie space robot. 
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Figure 1 1. Elliptical paths in the space of the independent joint variahles of the three link 
redundant robot. Path I is the initially chosen path and Path II is the optimized path. 
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-2 - 1 0 



X (m) 

Figluo 12. Tho dosed path in the figure de|)icts an end-elTector Uajeelory that will i>ro(lm e 
repeatable joint motion under pseudoinverse eontrol. The figure also shows the eonfiguiii- 
tion of the redundant manipulator at six different points along the trajectory. 
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Figure 13. The repeatable joint trajectories of the three link redundant manipulator gen 
erated through i)seudoinverse control of the end-effector trajectory in Figure 12. 
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